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This  report  is  the  first  of  two  treating  the  problem  of 
doppler/bearlng  tracking  of  a moving  target  by  means  of  a single 
directional  sensor.  A method  of  estimating  target  track  parameters 
by  processing  bearing  information  only  is  developed.  A forthcoming 
report  will  address  the  problem  of  combining  doppler  and  bearing 
information. 


This  work  was  performed  under  task  AIR  A370-3700/6W11-121-711 
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A TRACKING  ALGORITHM  USING  BEARING  ONLY 


INTRODUCTION 

It  is  possible  to  track  a moving  acoustic  radiator  by  means  of  a 
single  passive  sensor  which  measures  angle  of  arrival  and  frequency 
of  the  radiated  signal.  Although  in  theory  a very  modest  number  of 
independent  angle  and  frequency  measurements  are  required  in  order 
to  determine  the  target  track,  in  practice  the  effects  of  noise  make  j] 

it  highly  desirable  to  process  as  many  observations  as  possible.  :j 

The  best  estimate  of  target  track  is  then  determined  by  means  of 
a least  squares  or  maximum  likelihood  fit  to  the  observations. 

The  process  of  fitting  the  estimated  track  to  the  data  may  be  carried  ; ] 

out  by  batch  processing  a large  block  of  observations  simultaneously  ' 

or  by  an  iterative  scheme  such  as  the  Kalman  filter  which  processes  [ | 

each  nev;  observation  as  it  is  received.  M 

The  equations  which  relate  the  target  track  parameters  to  the  1 1 

frequency  and  angle  of  arrival  of  the  signal  received  at  the  sensor  • | 

are  non-linear.  This  considerably  complicates  the  process  of  per-  : j 

forming  a least  squares  or  maximum  likelihood  fit.  Generally,  rather  j 

than  perform  an  exhaustive  multl-dlmenslonal  search  for  the  estimate  ■ ? 

that  yields  the  best  fit,  the  equations  are  linearized  about  some  ■ 

reference  solution  and  solved  with  linear  theory.  This  technique 
is  used  in  both  the  batch  and  iterative  formulations.  In  either 
case  the  validity  of  the  final  result  is  dependent  upon  whether  \ 

or  not  the  reference  solution  was  sufficiently  accurate  so  that  I 

convergence  to  a true  minimum  error  solution  actually  occurred  i 

rather  than  divergence  or  convergence  to  a false  minimum.  As  the  I 

observations  become  more  noisy  this  problem  becomes  accentuated. 

The  approach  taken  in  this  paper  is  that  the  overall  tracking 
problem  can  be  divided  into  two  parts.  Information  about  the 
target  track  can  first  be  extracted  from  angle  of  arrival  observations, 
and  then  as  a second  step  frequency  observations  can  be  used  to  ' 

complete  the  target  track  estimate.  Splitting  the  solution  into  two 
parts  simplifies  the  problems  associated  with  linearization  and 
initialization  by  reducing  the  number  of  state  parameters  under 
consideration  at  one  time  and  also  makes  it  possible  to  employ  j' 

different  techniques  in  solving  the  two  problems.  The  specific  !, 

problem  considered  in  this  paper  is  the  processing  of  angle  of  arrival 
observations  by  a bearing  tracker  to  yield  an  estimate  of  target 
track  parameters.  The  processing  of  frequency  observations  will  be 
considered  in  a later  paper.  ■ 
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The  bearing  tracker  employs  an  extended  Kalman  filter  formulated 
in  such  a way  that  the  filter  is  linear  in  two  of  the  three  state 
variables  and  non-linear  in  the  remaining  one.  A conventional 
linearization  procedure  is  used  with  respect  to  this  third  variable. 
However,  Instead  of  assuming  or  in  some  manner  deriving  a single  point 
about  which  to  linearize,  a family  of  solutions  is  carried  out  in 
parallel  so  that  under  all  circumstances  one  of  the  solutions  lies 
in  the  region  where  the  assumptions  used  in  the  linearization 
procedure  are  valid.  Thus  the  Kalman  filter  requires  no  apriori 
knowledge  in  order  to  begin  processing  observations. 

STATE  DEFINITION 


To  define  the  path  of  a target  moving  in  straightline  unaccelerated 
motion,  a four  dimensional  state  is  required.  A tracker  using  bearings 
only  is  incapable  of  providing  all  four  necessary  parameters;  at  most 
three  can  be  determined.  The  state  representation  chosen  for  use  in 
the  bearing  tracker  is: 


— — 

V . 

X 

" R ^o 

1 

V 

X2 

R 

x^ 

6 

where  V is  the  target  velocity 

R is  the  range  at  closest  approach 

t^  is  the  time  of  closest  approach  referenced  to  initial 
acquisition 

6 is  the  bearing  from  the  sensor  to  the  target  at 
closest  approach. 

The  geometry  is  shown  in  Figure  1. 

If  additional  Information  concerning  V or  R derived  either  from 
apriori  information  or  from  processing  doppler  information  can  be 
provided,  then  the  target  path  is  completely  determined.  Lacking  such 
information,  the  tracker  output  is  a family  of  parallel  paths  bounded 
on  one  side  by  the  sensor  and  on  tJie  other  by  the  maximum  speed 
capability  of  the  target. 
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KALMAN  FILTER 

The  bearing  tracker  must  produce  an  estimate  of  the  target 
track  parameters,  or  system  state,  based  on  a sequence  of  noisy 
bearing  observations.  The  assumption  is  made  that  the  target  follows 
a straight  line,  constant  velocity  path.  The  system  equations  are: 


= h(X)  + V. 


Where 


X = X, 


is  the  system  state. 


e Is  the  bearing  measurement  corrupted  by  noise  v. 


and  h(X)  = atn[^(t-t^)]  + 6 = atn[x,+x_t]  + x, 

no  1 j 


(See  Figure  1) 


The  measurement  noise  Is  assumed  to  be  Gaussian  with  zero  mean  and 
known  variance.  The  only  non-linear  function  appearing  in  the  system 
equations  is  h(X),  the  relationship  between  the  bearing  measurement 
and  the  state.  The  first  step  in  the  Kalman  filter  formulation  is 
to  replace  h(X)  by  a linear  approximation.  Two  operations  are  performed 
in  the  linearization  of  h(X): 


1.  A non-linear  function,  the  tangent,  is  applied  to  the 
bearing  observations. 

2.  The  resulting  function  is  linearized  about  an  assumed  value 
of  x^,  the  bearing  at  closest  approach. 
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Instead  of  Initially  committing  the  solution  to  a single  assumed 
value  of  xo,  which  may  later  turn  out  to  be  erroneous,  the  problem 
is  worked  In  parallel  assuming  a family  of  values  of  X3.  This 
removes  the  necessity  of  an  initial  state  estimate.  Later  as  the 
solution  unfolds  it  Is  possible  to  reject  all  but  the  closest 
assumed  value  of  X3. 

The  linearization  proceeds  as  follows: 


0 = atn(x^+X2t)  + x^  + V. 

Let  i = 1,  ,n  be  a family  of  equally  spaced  reference 

angles  between  0 and  n.  The  periodicity  of  the  tangent  function 
Introduced  in  the  next  step  makes  it  unnecessary  for  y to  assume 
values  betv;een  n and  2ir. 


Let  y^  = tan(e-Yj,)  = tan[atn(x^+X2t ) 
+ (x^-Y^)  + v]. 


The  linear  approximation  to  this  equation  is 


where 


Cx^,  X2,X2~Yj^3 


3y.  3y.  3y. 

_ r £ £ £1 

i ^ 3x^  ’ 9x2  * ax^-* 

V. , the  noise,  is  amplified  by  the  non-linear  tangent  function  so  tha 
to  first  order 


var(v. ) 3y . 2 

1 

var (v ) 3v  ^ 


Then 
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M 


1 


l + (x^+X2t ) 


7 


l+(x^+X2t)^ 


1+Yi^] 


and 


var (v^ ) 
var Cv) 


(1+Yi^ 


2 

) . 


The  measurement  matrix  can  be  simplified  as  a result  of  two 
further  assumptions: 

1)  Assume  x,  - y.  is  small  for  the  Y.  closest  to  x_.  This  is 
true  if  n has-been  chosen  sufficiently  large.  ^ 

2)  Assume  that  the  input  bearing  measurements  have  previously 
been  averaged  over  a sufficiently  long  period  of  time  so  that 
their  variation  due  to  noise  is  not  excessive. 

Under  these  assumptions: 


y^  = tan[atn(x^+X2t ) + (x^-Y^)  + v] 

(x^+X2t)  . 

Substitution  of  this  result  into  the  previously  derived  expression 
for  Mi  yields  the  approximation 


M^  = [1,  t,  l+yj_^]  . 

This  simplification  is  significant  because  it  frees  the  Kalman  filter 
equations  from  any  dependence  upon  the  estimated  state  or  past 
measurements  and  makes  the  equations  dependent  only  upon  the  present 
measurement . 

The  Kalman  estimator,  shown  for  clarity  in  continuous  form,  is 
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Xi  = Z"\R-^(y^-M^X^) 


. T -1 


where  X^  is  the  estimate  of  the  state, 


■ 


Z^  Is  the  Inverse  of  the  covariance  of  X^ 

2 

= [l,t,l+y^  ] is  the  measurement  matrix 

y^  = tan(0-Yj^)  is  the  measurement 
2 2 

R^  = R0(lry^  ) is  the  variance  of  the  measurement 

where  Re  is  the  variance  of  the  input  bearings. 

The  implementation  of  these  equations  requires  an  initial  state 
estimate  and  associated  covariance.  To  avoid  this  we  transform 
the  first  equation  to  one  in  the  variable  2^Xj^. 


ZiXi 


MiRi^(yi-MiXi) 


= M^R'^y^  + (2-m'[r"-'m^)X^ 


T -1 

* ri  *^11 


= 
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At  any  time  that  a staj^e  estimate  is  required  as  output,  must 
be  inverted  to  obtain  Xi  = Zj^"^ (Zj^X^ ) . 

The  above  filter  formulation  has  been  based  on  n solutions  being 
carried  on  in  parallel,  each  assuming  that  X3  was  in  proximity  to  a 
particular  The  yi  were  chosen  to  lie  at  equal  intervals  between 

0 and  IT.  After  the  n filters  have  been  processing  bearing  Inputs  for 
some  period  of  time  it  is  desirable  to  reject  all  but  the  correct 
filter  and  use  its  output  to  calculate  a state  estimate.  In  addition, 

Xo  may  be  between  it  and  2ir  rather  than  between  0 and  ir;  and  this 
ambiguity  must  be  resolved. 

Assume  B lies  between  yj  and  yj+t  where  y-j+i  - = Ay  and  B - yi  = 

£.  Then  ideally  the  J'*-!'  filter  will  have  an  output 


The  J+lth  filter  will  have  an  output 


(X3)j^l  = 6 - Yj^^  = £ - Ay  < 0 . 


The  test  to  locate  the  correct  filter  pair,  j and  J+1,  consists  of 
tabulating  all  cases  in  which 


and  then  selecting  the  pair  which  minimizes 


(X3)j 


^*3^J+1 


- Ay 


In  general  only  one  or 

(^3)1  > C and 

of  the  selected  filler 


two  pairs  of  adjacent  filters  will  pass  the  test, 
< 0.  Linear  Interpolation  between  the  outputs 
pair  yields  the  final  state  estimate: 
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’'J 


- ) 

^ 3^J+1 


^*2^J+1  • 

^J+1 


The  ambiguity  of  tt  in  6 exists  because  the  tangent  function  is 
periodic  with  period  ir . This  ambiguity  can  be  resolved  by  using  the 
fact  that  no  observed  bearing  should  differ  from  6 by  more  than  n/2. 

Thus  comparison  of  the  estimate  of  6 with  a recent  bearing  or  average 
of  recent  bearings  will  Immediately  show  whether  or  not  n should 
be  added  to  achieve  consistency  with  the  observed  bearing  data. 

COMPUTER  FLOW  CHART 

Figure  2 shows  a flow  chart  of  the  bearing  tracker.  The  left 
most  loop  processes  each  input  bearing,  updating  all  n filters. 

All  essential  information  about  the  state  is  generated  and  stored 
by  this  loop  but  not  in  a form  that  can  be  readily  outputted.  The 
right  hand  sequence  is  used  whenever  an  output  is  required.  It 
rejects  all  but  two  of  the  n filters,  interpolates  between  them, 
resolves  the  ambiguity  of  tt,  and  outputs  the  states. 

SIMULATION  RESULTS 

A limited  computer  simulation  has  been  conducted  to  evaluate 
the  performance  of  the  bearing  tracker.  A minicomputer  was  used  to 
generate  a straight  line  target  track,  calculate  true  bearings  from 
a sensor  to  the  target  as  a function  of  time,  and  add  Gaussian  noise 
to  these  bearings.  The  bearing  tracker  algorithm,  programmed  in  the 
same  computer,  was  used  to  process  these  noisy  bearings  to  obtain 
target  track  parameters.  At  the  end  of  the  target  track  a comparison 
was  made  between  the  state  estimated  by  the  bearing  tracker  and  the  jj 

true  state. 

The  simulation  was  limited  to  a single  class  of  target  tracks 
shown  in  Figure  3.  Tracking  began  with  the  target  15000  feet  from 
CPA  and  continued  until  the  target  was  5000  feet  past  CPA.  Closest 
approach  was  8000  feet.  Target  speed  was  l6  feet  per  second,  approxi- 
mately 10  knots.  The  bearing  at  CPA,  6,  was  allowed  to  vary  over  a 
limited  range. 

The  Gaussian  noise  added  to  the  bearing  measurements  was  giver 
a variance  proportional  to  the  square  of  the  range  to  the  target. 

It  was  assumed  that  the  noisy  bearing  measurements  had  been  averaged 
for  T seconds  before  being  processed  by  the  bearing  tracker.  The  noise 
variance  for  each  measurement  was  determined  by  the  formula: 


I 


11 


12 
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2 

0 


(8000)' 


2 

o 


o 


where 

2 

o is  the  noise  variance 

r is  the  range  in  feet 

T is  the  time  between  bearing  measurements  in  seconds 
2 

0 is  the  reference  variance  at  CPA  assuming  1 minute  time  between 
measurements . 

The  value  of  T actually  used  in  the  simulations  was  50  seconds. 

Along  with  each  noisy  bearing  measurement  the  bearing  tracker  was 
given  the  variance  of  the  measurement.  In  an  operational  system 
such  variance  information  would,  of  course,  not  be  known  and  would 
have  to  be  estimated. 

In  order  to  save  computer  time  only  three  filters  were  actually 
Implemented  in  the  simulations.  The  filters  were  centered  at  45°- 
l80°/n,  ^5°  and  ^5°  + l80°/n  where  n is  the  total  number  of  filters 
being  simulated.  The  bearing  at  closest  approach  of  the  target  was 
varied  by  a random  number  generator  having  a uniform  distribution 
between  45°  - 90°/n  and  45°  + 90°/n.  This  simplification  was  Judged 
to  be  valid  based  on  a number  of  Monte  Carlo  runs  using  all  n filters. 

The  number  of  filters  employed,  n,  represents  a compromise 
between  algorithm  accuracy  and  computer  loading.  The  estimate  of 
any  target  track  having  a true  value  of  e not  precisely  centered  on 
one  of  the  filters  will  be  subject  to  biases  in  the  algorithm  as 
well  as  errors  due  to  noisy  bearing  measurements.  As  n increases  these 
biases  decrease.  To  study  this  effect  all  measurement  noise  was 
initially  removed  from  the  simulation.  A single  filter  was  programmed 
with  Y = 45°,  and  B was  varied  in  1°  increments  from  34°  to  68° 
to  determine  the  error  in  the  estimate  of  B.  The  results  are  shown 
Ir  Figure  4.  It  is  apparent  from  the  curve  that  if  n = 1C  and  the 
filter  spacing  is  thus  l8°,  bias  errors  in  the  order  of  1°  will  result. 
To  verify  the  relationship  between  error  in  the  state  estimate  and  n, 
a Monte  Carlo  analysis  was  run  with  a very  small  value  of  bearing 
measurement  noise,  .1°.  The  number  of  filters  was  varied  between  5 
and  100.  The  observed  errors  in  the  state  estimate  were  normalized 
to  the  errors  which  should  be  achieved  by  an  ideal  extended  Kalman 
filter.  The  performance  of  the  ideal  filter  was  evaluated  with  the 
expression^ 


^Jazwinski,  A.  H.,  Stochastic  Process  and  Filtering  Theory,  Academic 
Press,  1970. 
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P = [JVr"^M  dt]"^ 
o 


The  diagonal  elements  of  P represent  the  mean  squared  errors  of  the 
state  components.  The  results  are  plotted  In  Figure  5.  For  large 
numbers  of  filters  the  bearing  tracker  approaches  the  performance 
of  an  Ideal  Kalman  filter,  but  as  the  number  of  filters  decreases 
the  bias  errors  become  appreciable.  For  example  n = 10  causes  the 
bearing  tracker  performance  to  be  equivalent  to  an  ideal  filter 
operating  upon  bearing  measurements  having  a standard  deviation  of 
about  1°,  whereas  In  fact  the  measurements  had  a standard  deviation 
of  .1°.  Since  in  practice  a bearing  tracker  would  seldom  operate 
upon  measurements  of  standard  deviation  smaller  than  1°,  the  choice 
of  n = 10  represents  a practical  compromise  between  accuracy  and 
computer  loading. 

With  the  number  of  filters  set  equal  to  ten,  a series  of  Monte 
Carlo  runs  were  made  to  evaluate  bearing  tracker  performance  as 
a function  of  bearing  measurement  error.  It  was  found  empirically 
that  filter  performance  was  improved  if  bearing  measurements  having 
a large  variance  were  pre-averaged  before  being  processed  by  the 
bearing  tracker.  The  variance  associated  with  each  input  bearing  was 
compared  to  a threshold  of  25  degrees  squared.  If  the  variance  was 
less  than  the  threshold  the  measured  bearing  was  used  as  an  input 
to  the  filter.  If  the  variance  exceeded  the  threshold  the  bearing 
was  combined  with  the  following  measurement  and  the  process  continued 
until  the  combination  had  a variance  below  the  threshold.  In  combining 
measurements  each  was  weighted  by  its  inverse  variance  and  the 
effective  time  of  the  measurement  received  the  same  weighting. 

The  Monte  Carlo  results  with  this  preaveraging  technique 
applied  are  shown  in  Figures  6,  7,  and  8.  Each  plotted  point  represents 
the  RMS  error  in  the  state  estimate  at  the  end  of  the  track  obtained 
from  50  Monte  Carlo  runs.  The  theoretical  relationships  were  obtained 
by  evaluating  the  covariance  of  an  ideal  Kalman  filter.  All  three 
components  of  the  state  show  the  same  general  behavior.  For  small 
input  noise  the  performance  of  the  tracker  is  not  a function  of 
the  noise  but  is  limited  by  the  number  of  filters  employed.  For 
large  values  of  noise  the  performance  is  close  to  the  theoretically 
predicted  value. 

Figures  9 and  10  are  included  to  show  typical  results  obtainable 
with  the  bearing  tracker.  They  show  true  target  paths  and  once-a- 
minute  estimates  of  target  position  generated  by  the  tracker.  Error 
free  knowledge  of  target  velocity  was  provided  to  the  tracker  so  that 
all  four  components  of  the  state  could  be  determined.  Estimated 
target  position  was  plotted  from  the  fourteenth  minute  until  the  end 
of  the  track  although  input  bearings  were  processed  over  the  entire 
track.  In  Figure  10  the  target  made  a 30®  change  in  heading  over 
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NUMBER  OF  FILTERS 


FIG.  5 NORMALIZED  RMS  ERRORS  AS  A FUNCTION  OF  NUMBER 
OF  FILTERS 
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a 2 minute  period.  After  a sufficient  volume  of  input  data  about  the 
new  course  had  been  processed  the  tracker  correctly  evaluated  the 
new  value  of  6 and  slowly  de-emphaslzed  the  data  collected  prior  to 
the  maneuver.  The  overshoot  exhibited  in  this  case  is  typical  of  the 
tracker  response  to  mild  maneuvers. 

SUMMARY  OF  RESULTS 


Limited  computer  simulations  show  generally  good  agreement  between 
the  performance  of  the  bearing  tracker  and  the  theoretical  performance 
of  a maximum  likelihood  estimator.  At  high  signal  to  noise  ratios 
the  bearing  tracker  becomes  sub-optimum,  but  the  overall  result  is 
a system  which  will  function  very  well  with  input  bearing  errors  up 
to  5°  at  CPA  based  on  one  minute  integration  of  the  noise. 

The  major  advantages  of  the  algorithm  are  that  it  requires 
no  initialization  and  never  becomes  irrevocably  committed  to  a 
particular  solution. 
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